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CALCULATE PROVISIONAL CURRENT TIME GAIT UNTIL END TIME ON THE BASIS OF 
PROVISIONAL DESIRED ZMP AND OTHER CURRENT TIME GAIT PARAMETERS. 
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DETERMINE TERMINAL DIVERGENT COMPONENT qO[k] ACCORDING TO THE FOLLOWING 
EQUATION FROM BODY POSmONAELOOTY (Xe,Vxe) AT END OF CURRENT TIME GAIT. 

qO[k] = Xe + Vxe/a)0 
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DETERMINE TERMINAL DIVERGENT COMPONENT ERROR errq 
ACCORDING TO THE FOLLOWING EQUATION: 
errq = qO[k] - q" 
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CALCUUTE PROVISIONAL CURRENT TIME GAIT UNTIL END TIME ON THE BASIS OF DESIRED ZMP 
OBTAINED BY ADDING CORRECHON TO PROVISIONAL DESIRED ZMP ACCORDING 
TO RELATIONSHIP OF RG. 44, ASSUMING THAT a= A a. 
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DETERMINE TERMINAL DIVERGENT COMPONENT ql [k] ACCORDING TO THE FOLLOWING EQUATION 
ON THE BASIS OF BODY POSITIONAELOCITY (Xel,VxeT ) AT END OF CURRENT TIME GAIT 
RECALCULATED ON THE BASIS OF DESIRED ZMP TO WHICH CORRECHON HAS BEEN ADDED: 

ql[k].= XeT+Vxel/a)0 . 



DETERMINE PARAMETER SENSITIVITY r ACCORDING TO THE FOLLOWING EQUATION: 
r = (q1[k]-qO[k])/Aa ■ 
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ADD CORRECnON AMOUNT BASED ON a=-em^t TO PROVISIONAL 
DESIRED ZMP TO PROVIDE UPDATED PROVISIONAL DESIRED ZMP. 
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DETERMINE BODY INCUMATION RESTORING MOMENT ZMP-CONVERTED VALUE PATTERN ON THE BASIS OF 
DIFFERENCE BETWEEN HRMINAL BODY POSTURE ANGLE OF PROVISIONAL CURRENT TIME GAIT AND INITIAL 
BODY POSTURE ANGLE OF NORMAL GAIT AND DIFFERENCE BETWSN TERMINAL BODY POSTURE ANGULAR 
VELOCITY OF PROVISIONAL CURRENT TIME GAIT AND INITIAL BODY POSTURE ANGULAR VELOCITY 
OF NORMAL GAIT. 



DETERMINE AS DESIRED ZMP PATTERN, THE PATTERN OBTAINED BY ADDING BODY INCUNATION 
RESTORING MOMENT ZMP-CONVERTED VALUE PATTERN TO PROVISIONAL DESIRED ZMP PATTERN. 
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DETERMINE ANTIPHASE ARM SWING RESTORING ANGULAR ACQLERATION PATTERN ON THE BASIS 
OF DIFFERENCE BETWEEN TERMINAL ANTIPHASE ARM SWING ANGLE OF PROVISIONAL CURRENT TIME 
GAIT AND INITIAL ANTIPHASE ARM SWING ANGLE OF NORMAL GAIT AND DIFFERENCE BETWEEN TERMINAL 
ANTIPHASE ARM SWING ANGULAR VaOOTY OF PROVISIONAL CURRENT TIME GAIT AND INITIAL 
ANTIPHASE ARM SWING ANGULAR VaOQTY OF NORMAL GAIT. 
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INITIALIZATION 

TIME FOR GENERATING PROVISIONAL GAIT k=0 
TERMINAL STATE OF LAST TIME'S DESIRED GAIT THAT HAS BEEN CONVERTED 
TO CURRENT TIME'S GAIT SUPPORTING LEG COORDINATE SYSTEM IS TAKEN AS 
INITIAL STATE OF CURRENT TIME'S GAIT 
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DETERMINE DIFFERENCE IN HORIZONTAL BODY POSITION BHWEEN MODELS, 
WHICH IS THE DIFFERENCE BEIWEEN HORIZONTAL BODY POSITION OF 
CORRECTED GAIT AND HORIZONTAL BODY POSITION OF ORIGINAL GAIT. 
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DETERMINE DIFFERENCE IN BODY POSTURE INCUNAT10N ANGLE BEIWEEN MODELS, 
WHICH IS THE DIFFERENCE BETWEEN BODY POSTURE INCUNATION ANGLE OF CORRECTED 
GAIT AND BODY POSTURE INCUNATION ANGLE OF ORIGINAL GAIT. 



S2202 



GO 

m 

I 

> 

1— 

m 

o 
O 

:5 



DETERMINE DIFFERENCE IN ANTIPHASE ARM SWING ANGLE BEWEEN MODELS, 
WHICH IS THE DIFFERENCE BETWEEN ANTIPHASE ARM SWING ANGLE OF 
CORRECTED GAIT AND ANTIPHASE ARM SWING ANGLE OF ORIGINAL GAIT. 
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DETERMINE REQUIRED VALUE OF MODEL HORIZONTAL BODY POSITION STABIUZATION FLOOR 
REACnON FORCE MOMENT NECESSARY TO CONVERGE DIFFERENCE TO ZERO ON THE BASIS OF 

DIFFERENCE IN HORIZONTAL BODY POSITION BEIWEEN MODELS. 
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DETERMINE REQUIRED VALUE OF MODa BODY POSTURE INCUNATION ANGLE STABIUZATION 
FLOOR REACnON FORCE MOMENT NECESSARY TO CONVERGE DIFFERENCE TO ZERO ON THE BASIS 
OF DIFFERENCE IN BODY POSTURE INCUNATION ANGLE BEIWEEN MODELS. 



DETERMINEREQUIRED VALUE OF MODEL ANTIPHASE ARM SWING ANGLE STABIUZATION FLOOR 
REACTION FORCE MOMENT NECESSARY TO CONVERGE DIFFERENCE TO ZERO ON THE BASIS OF 
DIFFERENCE IN ANTIPHASE ARM SWING ANGLE BETWEEN MODELS. 
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DETERMINE MODEL HORIZONTAL BODY POSITION STABIUZATION MOMENT, MODEL BODY POSTURE ANGLE 
STABIUZATION MOMENT, MODEL ANTIPHASE ARM SWING ANGLE STABIUZATION MOMENT, HORIZONTAL 
BODY ACCELERATION, BODY POSTURE ANGULAR VELOCITY, AND ANTIPHASE ARM SWING ANGUIAR 
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SPIN DETERMINING SUBROUTINE 
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SLIPPAGE VIBRATION DETERMINING SUBROUTINE 
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